//TIM3 PA6 CH1 控制左后
//TIM3 PA7 CH2 控制左前
//TIM3 PC8 CH3 控制右前
//TIM3 PC9 CH4 控制右后
#include "dri_motion.h"
#include "dri_servo.h"
void dri_motion_ago(void)
{
	int angle = 0;
	while(1)
	{
	for(angle = 0; angle <= 360; angle += 10)
        {
            servo_set_angle_ch1(angle);  // PA6
            servo_set_angle_ch2(angle);  // PA7
            servo_set_angle_ch3(angle);  // PC8
            servo_set_angle_ch4(angle);  // PC9
            dri_systick_ms(100);
        }
	}
}